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^ @ An active virtual pivot hand controller (10) using motors to control reflective forces and torques. Degree of 
^ freedom parameters, stops, and reflective force rates may be easily modified without altering hardware. The 
^ location of the virtual pivot of the hand controller may be likewise readily changed. 
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Reld of the Invention 

The present invention pertains to hand controllers according to the preamble of claim 1 and particularly 
to aircraft hand controllers. More particularly, the invention pertains to displacement aircraft or space vehicle 
5 hand controllers. 

Related Art 

The related art involves conventional hand controllers which rotate atwut a fixed axis in ttte base, 

10 require movement of both the arm and the wrist, have a high force displacement gradient, and have either 
no or complex proprioceptive feedback. 

In recent years, space and weight constraints in modem aircraft have resulted in compact fly-by-wire or 
fly-by-light control systems. Such systems reduce the size and weight of flight control hardware in the 
cockpit. In addition, these systems permit a side-ann controller configuration that reduces otistruction of the 

»5 instrument panel area directly in front of the pilot Two general configurations of those compact controllers 
have been developed— rigid and movable displacement. Rigid controllers measure the force of the control 
input and have no movement associated with input magnitude. Moveable controllers have a range of motion 
of about ± 5 cm (± 2 incfies) to ± 10 cm (± 4 inches) associated with the magnitude of ttte control input. The 
force required to fully displace a moveable controller may be quite small, although the inclusion of a force- 

20 displacement gradient has been found to improve control performance. 

Difficulties are associated with both types of hand controllers. Rigid controllers may produce severe 
operator fatigue due to a lack of proprioceptWe feedback to tell ttie pitot how much force he is exerting. 
That difficulty can be reduced by allowing for a small (i.e., ± 6 mm or ± 1/4 inch) amount of displacement or 
wobble unrelated to the force-output hjnclion. Further, rigid controllers provide fairly imprecise control and 

25 suffer from input axis cross-coupling, again due to the poor proprioceptive feedback provided to the 
operator. 

Moveable controllers can provide reasonable control when a fairiy heavy-force output gradient (i-e., i. 
6,8 kg or > ± 15 pounds at full displacement) is used; however, these force requirements result in operator 
fatigue. At lower force requirements, control imprecision and axis cross-coupling are resulting problems. 

30 Some of these problems were sohred upon the conception and development of a moveable hand 
confoller configuration that permits accurate control while requiring a relatively low force-displacement 
gradient. Also, such hand controller is useful in a side-arm configuration in that it allows the operator's arm 
to remain essentially motionless in an arm rest while control iniMJts are made about the fulcrum of the wrist. 
When the operator provides an input, such hand controller assembly is rotated in an arc having its center at 

35 the operator's wrist and/or center is translational. The hand controller also has the advantage of rotation 
about the operator's wrist joint, thus requiring movement of the wrist only. In other words, that hand 
controller has a "virtual pivot" that permits inputs to be made about any point in space and the controller 
translates movement of the contix}ller grip about a point in space (such as the operator's wrist joint) into 
movements of a sensor about an internal reference point thereby penmitting one hand controller to optimally 

40 function for all hand sizes. However, tfiat controller has a grip and a sensor platform with a small- 
displacement and a motion base with spring-loaded legs for fiexibirity. Such hand conti-oller is disclosed in 
EP-A1-0 363 739. 

Departing from this known hand controller, it is the object of the present invention to further improve it 
so that it can be matched to diffemt applications. Tfiis object is achieved according to the characterizing 
•45 features of claim 1 . Further advantageous embodiments of the improved hand controller may be taken from 
the dependent claims. 

Summary of the Invention 

50 The present invention is still yet a further improvement on the related art. Not only does the present 
invention have a virtual pivot which accommodates variations in operator action, have six degrees of 
freedom, and variat>le pivot rx>int locations: ihe invention is adaptable for providing various forces and 
torques and displacements and rotations artd provides force feedback which simulates spring-type feedback 
but having different rates, various stop positions, variable damping, and a variety of reflective conditions to 

55 the controller environment including impact, proximity, limits, etc. The system of the invention has a hand 
controll er incorporati no-sxst em actuators, system sensors and feedback actuators which are connected to 
s ystem control and force feedback corttrol mechanisms which implement a variable control algontftm . i tie 
controller has a hand grip platform which is supported by telescoping legs. Linear actuators drive the 
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telescoping motion in the legs. Motors drive radial angular motion at ttte universal joints wtiich attach the 
legs to the base plate. A force/torque sensor is attached to the hand grip platform and monitors control 
inputs from an operator of the hand controller. There are angular potentiometers, linear potentiometers, and 
motor tachometers associated with the telescoping legs. The potentiometers provide a measurement of the 

5 position and attitude of the platform with respect to the base. Signals from the force/torque sensor, angular 
potentiometers, linear potentiometers and motor tachometers are input into the control system. The control 
system sends signals to the motors to drive the hand controller to the commanded configuration with the 
appropriate force and feel characteristics at the hand grip. 

The virtual pivot of the hand controller system accommodates a wide variety of operator sizes with a 

10 "floating" pivot point. Motors and controllers replace springs of the related art hand controller and yet 
provides force feedt>ack or "feel". Spring rates, spring tension, damping rates, stop positions, the numljer of 
control axes, the dimensions and range of control axes, and force reflection characteristics may be 
programmed with various values based on specific requirements into the control system. The program- 
mability and flexibility of the hand controller system permits the controlling of a large and varied range of 

IS devices with a single hand controller. The hand controller system may t>e programmed to compensate for 
various gravities, various gravity and inertial effects, or for gravity-free environments. Applications of the 
hand controller system include use in space stations, space vehicles, helicopters, fixed-wing aircraft, 
underwater vehicles, rotxitic vehicles, rotx>tic arm corrtrols. and other applications. 

20 Brief Description of the Drawings 

Rgure 1 is a drawing of hand controller. 

Rgure 2 is an overview diagram of tfie hand controller, control system, and the controlled system. 
Figure 3 is a graph showing the relationship of hand grip-applied force/torque versus hand controller 
25 movement displacement profiles. 

Rgure 4 illustrates the vector relationships between base and platform coordinate frames of the virtual 
pivot haiKl controller. 

Rgure 5a and 5b constitute a signal flow diagram of the control system and motor channels. 
30 Description of the Preferred Embodiment 



Rgure 1 reveals an adaptable six degree of freedom virtual pivot hand controller 10. Virtual pivot hand 
controller 10 has a hand grip 28 for the operator's input. Hand grip 28 is connected through grip platform 30 
to six degree of freedom force and torque sensor 34. Forge a nd torque sensor 34 is an F /T series, model 

35 75/250 sensor from Assurance Technologies, Inc., of Gamer, NC 27529. Cirip platform 30 is connected to 
shafts 62 via ball joints 32. Three shafts 62 extend into th ree linear actuators 36 . respectively. Linear 
actuators 36 cause shafts 62 to extend out of actuators 36 or to withdraw into actuators 36. The amount of 
shaft 62 extending out of linear actuator 36 is measured by linear potentiometer 38. Linear actuators 36 are 
driven by motors 40 thereby causing the extension or withdrawal of shafts 62. The withdrawal or extension 

40 of shafts 62 via ball joints 32 raise, lower, tilt, rotate and/or laterally move grip platform 30 and hand grip 28. 
The activity of motors 40 driving linear actuators 36 is monitored by tachometers 42. Unear actuators 36 
are attached to universal joints 60, respectively. The other ends of the universal joints 60 opposite of linear 
actuators 36, are effectively attached to base plate 48. Six potentiometers 44 are, respectively, attached to 
universal joints 60 for measuring the angles of linear actuators 36 relative to base plate 48. The angle of 

45 linear actuator is 36, relative to base plate 48, is driven and set by motors 52 via gear heads 50 and wonm 
and worm wheel assemblies 46. Gear heads 50 are attached to motors 52 through base plate 48 to worms 
46. Worms 46 drive wonn wheels 46 which are attached to tfie portions of universal joints 60 that are rigidly 
attached to linear actuators 36, respectively. Worms 46 driving worm wheels 46 set linear actuators 36 and 
shafts 62 to particular angles of inclination. Motors 52 are monitored by tachometers 54. Base plate 48 is 

50 supported by a surface 58 with structural supports 56. Surface 58 represents the place or area upon which 
hand controller 10 is situated and mounted. 

Rgure 2 reveals an overall diagram of the adaptattle six degree of freedom virtual pivot hand controller 
10 system. Hand controller 10 outputs sensor signals 20 from six degree of freedom force and torque 
sensor 34, linear potentiometers 38, angular potentiometers 44. motor tachometers 42 and motor tacho- 

55 meters 54. Sensor signals 20 are input to control system 12 which is a processor and specifically a 
Motorola VMBtJus 68020 single board microcomputer, having system control 14 and force feedt>ack control 
16. Force and torque sensor 34 which is attached to han d grip platform aQri hand grip mor iitors the c otrtroL^ 
inputs from the operator. (^mtrtST sysIe?n~42,-m.-fespon§e to sensor signals 20, sends feedback signals _toj) 
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motors 40 and 52 to drive hand controller 10 in accordance with the commanded configuration, having 
appropriate force and feel characteristics. Ttie force and feel characteristics are determined by force 
feedt>ack control 16 and response to sensor signals 20 revealing force, torque, position and rate, and 
signals from controlled system 18 sensors indicating proximity, force, field dynamics, etc., in response to 
driving signals 22 to system actuators such as motors, propulsion, etc. Hand controller 10 uses motor 
biasing to generate the force and feel of springs, damping and mechanical deadbands as illustrated in 
Rgure 3. Rgure 3 is a graph of hand grip applied force and torque versus displacement profiles of hand 
grip 10. 

Control interface 22 required to determine hand control 10 orientation and translation In six degrees of 
freedom contains nine potentiometer measurements (three per leg) that define three position vectors of grip 
platform 10. corresponding to three fixed ball joints 32, with respect to the three ttase leg pivot points at the 
ends of shafts 62. During system calibration, a fixed displacement vector (from the origin of platform 30 
coordinate frame) of ttie operator's wrist joint is estimated. Rgure 4 showrs the vector relationships between 
btase 48 and platform 30 coordinate frames. Processor or control system 12. through force feedback control 
16. returns three Euler angles and three linear translations from nominal platform 30 origin. Additionally, 
force and torque sensor 34 inputs are used in either position or rate mode to command a six degree of 
freedom vek>ctty that motorized legs 36 and shaft drives 46 are to deliver. Thus, processor or control 
system 12 must first solve ttie geometric task of computing orientation and translation, and then compute 
the requisite leg or shaft rotationaJ and linear vekxities that result in ttie commanded and controller state. 

Kinematic solutions to the hand grip platform Euler angles (defining attitude angles) and linear 
displacements from the center of the coordinate frame are otitained by use of nine potentiometers. 38 and 
44. Fewer potentiometers can accomplish the same task of monitoring as the nine potentiometers. 
Telescoping legs or shafts 62 (whose links are actuator 36 driven) are attached to platform 30 by ball joints 
32 and to base 48 by double-gimbaled motorized joints 60. Outer gimbals 60 are rigidly attached to base 
48. are motor 52 driven, and cause a roll motion atwut the leg or shaft 62 motor axis of rotation. Outer 
gimbal 62 axis defines the leg or shaft 62 coordinate frame X-axis for each of the three legs or shafts 62. 
Tftese three axes are each oriented along tfte radial directions with respect to the center of t>ase 48. This 
results in the forward base 48 point having its motor axes along the X-axis of the base 48 coordinate frame. 
Azimuth angles to the other two base 48 points have constant values of 120 and 240 degrees, 
respectively. Inner gimbals 60 allow rotation atx>ut the respective leg or shaft 62 pitch axes. Designating the 
length of the three legs 62 d|, where i equals 1 , 2. 3, and is defined 0 < d^n < d| < dimax- Then the position 
vectors of platform 30 ball joints 32 with respect to base 48 frame Sb: 



Pi=Ei(«o) E(«i» H) 



+ Pfli; i = 1, 2, 3 



(1) 



COS 9 1 0 sin ei 

sin *i sin cos -cos »± sin 

-sin sin i± sin cos 0^ cos 



(2) 
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Ei(«o) = 



COS *o 
sin *o 
0 



-sin «o ® 
cos ^0 0 
0 1 



«0 = 0, 120, 240 deg 
for i - 1, 2, 3 



(3) 



Processor of control system 12 Is a Motorola VMEbus 68020-tx)ard microcomputer housed In a 
standard Motorola chassis having several analog-to-digital interface cards. Six tachometers 42 and 54 on 
three legs 62 measure motor speeds of leg-extending or retracting motors 40 and leg-angular rotating 

IS motors 52. There are tvw) motors, 40 and 52. per leg 62. Linear potentiometers 38 measure leg 62 
extension and two angular potentiometers 44 per leg 62 measure angles of each leg 62 relative to base 48. 
There is a total of nine potentiometers 38 and 44. 

Rate and position control modes of hand controller 10 differ. In the position mode, removal of grip, force 
and torque commands from the operator causes hand controller 10 to remain at its latest attained attitude 

20 and linear displacement. Removal of input in the rate mode will cause a return of hand controller 10 to the 
initial displacement origin. Any of the six degrees of freedom of hand controller 10 may be locked out as 
desired. Software stops are provided to prevent hand controller 10 from running into hard stops which might 



Rgures 5a and 5b constitute an overview signal flow diagram of hand controller 10 input and motor 
control channels. This diagram has correlation with the program listing at the end of this description. 
Force/torque sensor 34 is a strain gauge type of sensor for detecting applied force and torque to hand grip 
28 of controller 10. Interface 13 provides for keytx>ard or other type of input to the processor which includes 
input command processing 68 and motor command 70. Interface 13 is a RS-232 terminal interface for 
operator inputs of the controller 10 processor. Control system 66 provides for needed interaction among 
force and torque sensor 34, input command processing 68 and interface 13. Control system 66 includes 
sensor 34 electronics and control and may incorporate a Lord preprocessor and a Lord controller for sensor 
34, from Assurance Technok)gies, Inc., of Gamer, NC 27529. Controller function 72 incorporates software to 
perfonm the calculations of required motor rates to equal commanded input velocities of translation and 
rotation by incorporation kinematic system equations. Orientation function 74 incorporates software to 
perform the calculations of the platform and/or virtual pivot translation and rotation iwith respect to the base 
coordinate system. Inputs represent shaft or leg lengths, elevations and azimuth angles obtained from the 
nine potentiometers 38 and 44 (three per shaft or leg). Functkin 74 incorporates reverse kinematic system 
equations in its calculations. External object or device 18 receives input for external control and outputs 
signals for providing reflected force or torque (i-e., "feel" dynamics), or alarms. 

The foltowing describes the geometric relationships. Position vectors of the pivots are defined by Rbi 
and Hpi, where i = 1 , 2, 3, in the two separate frames Sb (the base 48 frame) and Sp (the platform 30 
frame), results in 



Rbi 











0 


; Rb2 = 




0 





-rB/2 
(V3 /2)rB 
0 



? RB3 - 



-rB/2 
-(V3 /2)rB 
0 
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rp 




-rp/2 




-rp/2 


Rpi = 


0 


; Rp2 = 


(V3 /2)rp 


; Rp3 = 


-(^ /2)rp 




0 




0 




0 



Rc = ^ e[ Ri + RBi ] - 



i=l 

since the sum E Rbi = 0. 



- E Ri 

3 



RC = - E Ei (*o) 
3 

i=l 



-di sin »i 
di cos sin 
-di cos $i cos 4± 



The above dot represents a matrix dot product. Referring to Figure 4, the platform 30 Xp unit vector is 
directed from the center toward Pi- The Yp unit vector is parallel to the line from P3 to P2, Then, 




50 



The direction cosines of the )(p. Yp, and Zp unit vectors are the components of the preceding vector 
equations. The Euler rotation matrix from Sb to Sp is ttien 

55 
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Xp Xfl Yp • Xb Zp • Xb 

Ep/B = Xp • Yp Yp • Yb Zp • Yb 

A A A A A A 

Xp • Zb Yp • Zb Zp • Zb 



- { 



The above dots represent vector dot products. 

All information concerning the relative attitude orientation t)etween ttie tiase 48 and platform 30 frames 
is contained in ttie Euler matrix Ep/s- Euler angles can be defined in 24 different ways depending on ttie 
sequence of rotations (in a positive sense attout each of three axes). There are 12 permutations starting 
with either frame Sp or Sb, or 24 total. Each set of three angles is not Interchangeable (except for very small 
rotations). Each set does, however, result in the same rotation of one frame to another when applied in its 
specific sequence. 

The following set arises from a yaw rotation about the Sb z axis followed by a pitch rotation tx>ut the y 
axis and a final roll atx>ut the x axis: 

♦p = tan-Yl 2/^11) = Yaw 
Sp = sin-'(*13) = Pitch 
.^P = tan-Y23/^) = Roll 

Each rotation assumes ttie right-hand rule for positive sense. The inverse transformation performs a roll- 
pitch-yaw transformation (in that order) which is not uncommon in the aircraft industry. 

The following describes the platform velocity equations. Tachometers 42 and 54 mounted on ttie 
handcontroller 10 legs and roll axis shafts are used in a velocity feedback controller 16 that drives each 
motorized leg 62 to null a separate commanded velocity. These six velociti'^ are in turn computed 
according to the six signals from force/torque sensor 34 (after tiiasing to provide reflected force or torque 
dynamics for the operator). 

At present, handgrip 28 force signals are interpreted as referenced to the base 48 coordinate frame as 
a linear velocity command. The coordinate system used is arbitrary and can be easily redefined in 
processor code and provided as an optional handcontroller 10 operating mode at a later time if desired. 

The inertial velocity Vi of each leg 62 is composed of ttie linear velocity of the platform 30 center 
summed with ttie rotational velocity about the center, that is 



= g| Ri = Ei (*0) 



d 
dt 



Ei(ri, di) 



0 

-di 



- Vc + «p (Ri - Rc) ; i = 1, 2, 3 



Vi = Oi («o, ^i, di) 



»i 

fi 
di 



= Vc + «*p (Ri - Rc) ; 
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where 9|, ^i, and d| are the time rate of change of angles 6i and leg length d) for each leg. Then, 



fi 



Oi'^ [Vc + wp (Ri - Rc)]; i = 1, 2, 3 



In the above equation, only the expressions for leg roll and length rates are of interest as the 
handcontroiler 10 leg 62 pitching rates are automatically driven by mechanical constraints. This solution 
requires inversion of a 3 by 3 matrix, where 

ni (»o» »ir ^i, di) - 



Ei(*o) 



0 -di cos«i -sin*i 

dl cos^i cos^i -di sin^i sin^i cos«i sin^i 
di cos^i sin^i di sin^i cos^i -cos^i cos^i 



i - 1, 2, 3 



The platform 30 angular velocity vector input commands, op, atrave are referenced to Sb: if they are 
instead referenced to Sp. they are simply converted by the inverse Euler transformation as follows: 



(i>Y 



«Yc 



The inverse Euler matrix is the transpose of the matrix since the coordinate frame is orthogonal and 
45 Cartesian. 

In summary, one feature of hand controller 10 is that the sensed location of the pivot point can be set 
arbitrarily, tt can be set through the center of grip 28, above or below it, or be centered inside the operator's 
wrist. For example, with a pivot point below grip 28, it would act like a conventional military aircraft hand 
controller having the pivot point where the control stick attaches to the floor or deck of the aircraft However, 

50 with the pivot point above grip 28, the top of the grip would be seemingly attached to a point above it and 
the grip woukJ swing freely below it The programmability of the pivot point provides for maximum flexit»lity 
artd adaptability of hand corrtroller 10. Ttiese changes in kx:ation of pivot point can be noade by entering the 
appropriate software commands in control system 12. An initial setting can be made by the operator 
through the movemerrt of his or her wrist for setting tfte virtual pivot and control swing and rotation 

55 dimensions in accordance with and to match tfte wrist movement Other operating ctiaracteristics can t>e 
changed simply by altering the software. Such things as break out forces, the degree of freedom available, 
damping rates, spring tensions and velocity rates can be modified wittraut altering the hardware of control 
system 12 or hand controller 10. Based on information from the vehicle or object being controlled, the 
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operator is given feedback through grip 28. This capability is force reflection and usually involves providing 
tactile feedback through grip 20 when the control object 18 (e.g., a rotx>t arm or vehicle) contacts the target 
or other object. The combination of a programmable virtual pivot point having an active hand controller 10 
altows the operator or user to configure hand corrtroller 10 to match or meet the demands or needs of a 
particular task and user. 

Motor-driven force feedbctck (microprocessor 12 control) replaces spring centering. Gradients of forces 
or torques versus displacements (in each of six axes), as shown in Rgure 2, are stored as parameters that 
can t>e modified by keytx>ard 13 input. Such modification provides adaptatiility or programmat^ility of key 
hand controller 10 operating characteristics including sensed (virtual) pivot axes locations and range of 
motion in each axis, sensed spring force reflection or the feel of grip 28 (i e., force/displacement gradients), 
the capability, as desired, to implement bilateral force feedtjack from system 18 t»eing controlled (via motor 
control feedback) to the human operator and the capability of operator-mode control to introduce menu- 
driven commands (via the VMEbus single-tx>ard computer). 



APPENDIX 



Software Listings for the Virtual Pivot Hand Controller 



Filenamg 



Descriptiftn 



handcntribowLc 

myfunc50hz.2^9.90 

hc4.c 

hc4.h 

dtoa.h 

ato<Lh 

myimth.h 

bowLc 

cmd.declaradonsJi 

cmd_defimtion.h 

makefile 



Stand-alone test program ftw die "ccmtrolte" function. 

Main prognim (intonipt driven). 

Merged "controller" and "orientation'' functions. 

Data structure definitkms. 

Digital-to-analog OMiveisions. 

Amdog-to-digjtal converaons. 

Sun Microsystems, Inc. utilides. 

Bowl demonstration mode declarations. 

Operator's terminal ii^mt ctnnmands. 

Data stnicture definitions. 

CcHi^nler macro ccnnmand file. 



N(rte: Additional file listings attached are minor utilities and data type definitions 
declarations comnKm to many gimnniin r im p iwww uatwwif 



or 
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A six degree-of-freedom virtual pivot controller (10) comprising: 
grip means (28) for receiving extemalty applied force and torque; 

force and torque sensing means (34), connected to said grip means, for sensing the force and torque, 
from up to six degrees-of-freedom, applied to said grip means; 

first support means (30), connected to said sensing means, for supporting said sensing means; 
second support means (48) for supporting said hand controller; 

at least one variable-length member means (62) having a first flexible connector (32) attached to said 
first support means (30) and a second flexible connector (60), attached to said second support means 
(48), for variable supporting said first support means, 
wherein said at least one variable-length memt>er means comprises: 

translation actuating means (36, 40) connected to said member means (62), for varying the length of 
said member means; 

translational sensing means (38). connected to said member means, for sensing a length of said 
member means; 

angular actuating means (46, 50, 52), connected to said memt>er means, for angularly moving said 
member means relative to said second support means; and 

angular sensing means (44), connected to said member means, for sensing an angular position of said 
member means relative to said second support means. 

Controller according to daim 1 further characterized by comprising processing and control means 
(12), connected to said force and torque sensing means (34), to said translational sensing means, to 
said angular sensing means (38), to said translational actuating means (36, 40) and to said angular 
actuating means (46, 50, 52), for receiving signals from said force and torque sensing means, said 
translational sensing means and said angular sensing means, and for sending signals to said 
translational actuating means and to said angular actuating means. 

Controller according to daim 2, characterized in that said processing and control means (12) sends 
signals to an external device (18) to be controlled by said hand confroller (10), and receives signals for 
the external device. 

Controller according to daim 3, ctiaracterbed In titat any externally applied force and torque to said 
grip means (28) is sensed by said force and torque sensing means (34) which in tum sends signals 
indicating force and torque to said processing and corrtrol means (12) which in tum sends signals 
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indicating certain kinds of control to the external device (18) being controlled which in turn sends 
signals of action and reflective force of the external device to said processing and control means which 
in turn sends signals of reflective force and movement to said translat'onal actuating means and to said 
angular actuating means which in turn provide reflective force, torque and movement in response to the 
5 any extemally applied force and torque to said grip means. 

5. Controller according to claim 4, characterized in that said grip means (28) reflects a virtual pivot point 
of said grip means having to the spring-lilce reflective force and torque, and movement to the any 
extemally applied force and torque. 

10 

6. Controller according to claim 4, characterized In that a location of the virtual pivot point and 
magnitudes of the spring-like reflective force and torque and of movement may be varied via input 
information to said processing and control means (12). 

75 7. Controller according to daim 1 , characterized in that said first flexible connector is a ball joint (32); 
said second flexible connector is a universal joint (60); 
said translation actuating means comprises a first motor (40), 

connected to said interface and control means (12), for drawing said actuating means which changes 

length of said variable length member (62); 
20 said translational sensing means comprises: 

a first tachometer (42) connected to the first motor and to said interface and control means; and 

a linear potentiometer (38) connected to said linear actuator and to said interface and control means; 

said angular actuating means further comprises a second motor (52), connected to said interface and 

control means, for driving said angular actuating means; and 
25 said angular sensing means comprises: 

a first angular potentiometer (44) connected to said universal joint and to said interface and control 

means; a second angular potentiometer (44) connected to said universal joint and to said interface and 

control means; and 

a second tachometer (54) connected to the second motor (52) and to said interface and control means. 
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CONTROLLER FUNCTION 
CALCULATION OF REQUIRED MOTOR 
RATES TO EQUAL COMMANDED INPUT 
VELOCITIES OF TRANSLATION AND 
ROTATION. 

(KINEMATIC SYSTEM EQUATIONS) 
INPUT COMMANDS REFER TO BASE 
COORDINATES FOR LINEAR VELOCITY 
OR TO PLATFORM COORDINATES FOR 
ANGULAR VELOCITY. 
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ORIENTATION FUNCTION 

CALCULATION OF THE PLATFORM 
AND/OR VIRTUAL PIVOT TRANSLATION 
AND ROTATION WITH RESPECT TO THE 
BASE COORDINATE SYSTEM. INPUT 
REPRESENTS THE LEG LENGTHS AND 
LEG ELEVATIONS AND AZIMUTH ANGLES 
OBTAINED FROM NINE POTENTIOMETERS 
(3 PER LEG) (REVERSE KINEMATIC 
SYSTEM EQUATIONS) 
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